function T = fkine(DH_para, q)
T = eye(4);
for i = 1:6
    T = T * TransformationMatrixMDH(DH_para.Alpha(i), DH_para.A(i), DH_para.D(i), DH_para.Theta(i), DH_para.Sigma(i), q(i));
end